#include "Sevro.h"


void Sevro_control(u8 num,u16 PWM)
{
    switch (num)
    {
    case 0:PWM_Out(1,PWM);
        break;
    case 1:PWM_Out(11,PWM);
        break;
    case 2:PWM_Out(12,PWM);
        break;
    case 3:PWM_Out(10,PWM);
        break;
    case 4:PWM_Out(0,PWM);
        break;
    default:
        break;
    }
}

void Sevro_Task_control(Servo_Data*servo_data,u16 Target)
{
    if(servo_data->Stat_PWM < Target)
    {
        servo_data->Stat_PWM = servo_data->Stat_PWM + 10;
        Sevro_control(servo_data->num,servo_data->Stat_PWM);
        
    }
    else if(servo_data->Stat_PWM > Target)
    {
        servo_data->Stat_PWM = servo_data->Stat_PWM - 10;
        Sevro_control(servo_data->num,servo_data->Stat_PWM);        
    }

}

